Prioritized Group Navigation With Formation Velocity Obstacles